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Abstract of JP 2000279425 (A) 

PROBLEM TO BE SOLVED: To visually and easily 
grasp a distance between a target object and an 
object and also to permit a user to easily obtain 
required kinds of navigation information. 
SOLUTION: The position and attitude of an 
endoscope 3 and a testee body 1 in a three- 
dimensional space are measured and navigation 
information for navigating the object to a target is 
generated. Then navigation information is displayed 
on a liquid crystal monitor 13 by changing a color, a 
line thickness, a plotting size and plotting density, for 
example, when the information is displayed in 
accordance with relation in the position and attitude 
of the endoscope 3 and the testee body 1 . 
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S«2 5(CiO*»4>#L4rtSft3<0«iW4, jfA-r^ 

4S«ft (Witf, 1 OK) ®±<?>m*iftf&t&i*& 

tcti, rtse3oiE»»»2 7<ofefcao*s*sfl:s 

#4. i^KftfciO. <£ffl£t±. ££e>rt«*3*># 

[ 0 0 7 0 ] „ *® 2 <0lUJS<^!BO««lfta . i 



[0071] mm. i-ty-is 3 vft&k t^mt 

mwmx vft&ztizimn&ta.k-rhz tire* 
4. tti. mmtzwski^m^-r. qmnwmom 

mz-t y v y>fy\s- y tm. 0 ft»t hiix o 4 fc tx . 

y $ a y 3 y €rff o i i: i ^t'$> 4 . 

[ 0 0 7 2 ] 3^7C{5S^H-pJ^g{i. fi^^ 

yfim^tzim^. mm**) yft^aj yht* 
yzt-y-*?#Tyi'3*-?$m\>vzljft%k\ HE 

t i < a 4> #ut 3 ^Tcfira^^ti-ai^^a # m^. 4 z 
^-t'y-y 3 >^*»^3<X7c(aiBB»*W'a!t-4^t 

-eJK=5r4„ 

[ o o 7 3 ] a^h*y-s/ 3 ynm&twixh 

•c ttfflm&EMfcWHfrs 4 i ^•C'$>#itf . rt^M 3 
^H^-f, ©?IW^t 0 y-fe-/h=S:i:ft!i^t^a^^t 
4ii:* i t'#4. 

[00743 ^^. nwm3^m<Dmmmmm^ 

SSfiS*^ n v * - 9 k ? 4 5r 

[00753 4^. SE^itc: J:4feO»i. ±1S^«^ 
[00763 P9«fc, ffidtfc i 4»<^>*$^)SSflai. ± 

Lti3£ttx-i>. imwm&mizx&mmmtx'hB: 

[ o o 7 7 ] ife. ii#oA#$^m^(±. 

[ o o 7 8 3 $ 4>£ x ^h>--y 3 ymmm&x-hh 
[00793 4^, tH-ey-i/ 3 ynmuz. wmm 

^^t-f4c:fc* i -c§4. 

[00803 32UJ36<7>»3Bfc3S-^V^**^*aWL 

ffi-C*4. *%,W<7)^%£ikisbZ>k&Tcr>£ 
9^=5:4. 

[0081 3 ( 1 ) *«MfcSrBlKi-t*y-hr4« 



i 
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h -mmm tx . munmrnm xmm titz 

[0082] ( 1 ) fclE»<0»JSfc^**ttOJB 

2&7C. Xtt3&^*r/HifcLT^$iiS<R£*> 
BHW fc*tr . 4 fc » JblEtt* b*y- v g y*«Mtrti . 

IE3a5cfiE»»fK«¥gBi. WlLEDJfflt^ 
yf (•fey-/y/7i/-N2, 4. •fey^r-by^'U 

7 . -b y^tt$gis^gi55 . -t >wmm 6 ) ansa-*- * 

#x HBl-fey?£ffl^fc#5!«>, WWWrU^fcyg 

fc^t'y-^gyflHBWiipafs^a-ri. uki**# 

[ 0 0 8 3 ] £0 ( 1 ) taa«0flliSfc: iWf . BMfc 

3 dfttiLEsmmz&t x o . 3 ascsisu: 

T, ^t>'-^gyK#g£ffi$8££j£-t*>. SSj^S 
■Wi, d^tffg^^ST'^L^-ft'^-^gytffg 

Wfith. £*>»£, ffiWSii. B«k«««ik<0E 

fix B»v>tfrtk ^f^x«ss* { ±te3 



[0084] ( 2 ) jjea^aw:. ±ie 3<^7c{as 
trapse * ^iM^mRxfiimmimmwi^ 

£ti, ±l£g^X(i±ieW^^^^ffi^x ±IES 
f»l*|g|5BJTJf1P8. ±MlBmt^i±S5MM^m 
[Six ±IEa^5^Sgf«ti#Wd*>x ^< i: t— 3* 
<£ftW)*§£{ix tramc**^**-*- 
flHB**^f 6£i:*1«8i:"t4JJE ( 1 ) isffi**)-*- 
b>'-y 3 yga. 

[ 0 0 8 5 ] Z<T> ( 2 ) (cffil^«j£fcW*43INW># 
1BU x ±IE» 1 RtfJS 2 ^BSt^JB^WJC-t l> . BP 
*»x ±l^^cttfB(ix mi^SM^ET'tiV-f^ 

7^-A3«x7E ; eT^T-^ i ommtitK ?mm 

tt*$mX'Z h*T)Vr-9X'bhlf--Wffi%3&7l3 
tr. 4/Sx JH2^>Wt«»BfiTli» ttm3<r)im&i& 

xxm^htihmi-ftmh^tj. ±immmmmiz. 
w, i im% 2 nm&nBmx'ii , *f&awa*) 3 <X7n^ y 

^^3 i«^-ri»* j x ffEco aii^^gEffiSr^-r 

<r> 2 wmmmn^nim^ 3 (jsaMnwii 
[ 0 0 8 6 ] 4 fc x umwftmx'h &zt zactim 

fix ^ 1 ^WfctfMWCIi r ifS9^ffHt®j tv^X^ 

*^-£ k ijaSfifcttt^E^^ 

^-y5r#tf. 

[0 087] (3) ±ieMm!Hj{iti^^a*mfiiLx 

vy-is 3 ymzm&ixm*smx'$>& z 1 
t-thHi ( 1 ) tieuo^h'^-^g ymm. 
[0088] zoo) ^m^mmzm-t z> m&w 
mi. mm 1 nmmnwmtmfoth . ip^x ±ies 

atix ^ 1 em&<mmx'UM£ , B : £-f 1 3^'Mi-ri. 

[0089] <I<7) ( 3 ) fciEH^fltrittci^Uf . ±12 
( l ) £tm<r)ttMmtfm&®i : 8bXto'). zcr>Wt 



< 



« 
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fifflZft-comgUKWMt LXmtLZZklzX o, 

[0090] (4) ±MiBmk±MStim><r)imx.it 
[0091] (4) tieiiofiijSfcM-f hmnk<m 

X'li, Z-f ±lzffiWZti&tmfflLe>E.W8ffi&2 6 
WflUA 3 «>jESt»« 2 7 tfS&th . 
[ 0 0 9 2 ] ( 4 ) fcEttOflbSK iiltf , ±IE3 

h. ttz. mmuwzmtxi-t'y-is 3 >w®<7) 

•fiiX \^hZkt£ £*tttttt£#Atte&?* Z k ipX' 
[0 0 9 3] (5) ±fEB*fcJJE*f*fttf>BaiXH: 

( 3 ) <oM<Tj&>tEa^t*y->' 3 >mw. 

l o o 9 4 ] ( 5 ) teisttoflustuw-siift^ 

*> , ±te^b-y- ^ 3 ym<m<Kk% a.m i ^ust 
1 8«<K3-t&« c , * i <rmk<mmx'<rm%2 
i) fttgg 3 oiott 2 7 #st a-r s . 

[ 0 0 9 5 ] £0) ( 5 ) KIE»tf>flMcfc: l*Ur. ±IB3 

ddttix&mmmtzx mmztitz±.mmk±m 

ifm^mtz^ktpk^nnmz^zwmth z t 
tfx-zh. ttz. im^n^zmtxi-\:y-^ay 

tim<7)»0)±Zt:%{kZit2>z\ktiz£') . ffiffl^ti. ffl 
t4 4. £>4^Ji. ««W*raii:*|6|*|iI 



[0096] (6) JbEBftfcJblBW^nlEJifcJE 

m<nfiMMSwmR-mzm*-?h z t zw&k-r 
4Jhts ( i ) Jbm. ( 3 ) ^Mft^fciEKtftf-try-i/ 9 

[ o o 9 7 ] ( 6 ) h %mm 

mi. Hffii<ry^<mmtfnmt&. w*>* jjw 

mm*. mi<om&(r>mmx'imm\mm 9mm-t 

[ 0 0 9 8 ] ( 6 ) (cEtt<o««fc «fcil«, ±IE3 
»Scffl!K5«H»afc:J: OfHI$nJt±IBIf[i:±IB 

rt^iilM i: * { «J 0 Wb h Z k lz X *) . m%li , *Mt 

ft**itkoifi< tcffla lt v^s i k £%&£.iemt& z 

ktfX'ZZ. itz. &MZtit:ime>[*i&k9\-&k^o 

mchimizfcttz i ftm®%i,z%h zktfx'% h . 
[0099] (7) i&nmt ±Mss#»%i<flemiizf6 
tx , ±Mim**mz amtTvmm&w&MZ z& 
ixm^thzkmWikthiii ( i ) nm o> <n 
Mii*H;iB«<7)^b'y*-^3 >mw.. 

[0100] Z<T> ( 7 ) fciEtt<9»j£fcW?-S!g|fi«>JB 

[ o i o i ] z<r> ( 7 ) (z£Kffttfftfcj:*ia . g^t 
%fflg&zwmtzj&tx&&z.k tfx-z h . 

[0 102] (8) ±aa»i:J^*f*!|!J<OKKtJC 
tT. lll&r^mz. IMimzmrfW&klMim 

nummiR-mzWfi^hzk zmsiki-z>±3i 

(i) nm o) v>wtitiHziffi<7)i-t''y-is a ym 

[0103] z<r> ( 8 ) £ie®<ofM£&&t i> mm<r>m 

m&frtmmi. mi<7)nm<7)BBX'ii r 74 j r7i'-j* 
&i8im%-t6tf* #vJy%k'v>3Wi3yv*- 
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[ 0 1 0 4 ] ( 8 ) fcEttOflbSK i*ltf. B^k 

^mm^mm^m^iiztx-. &m%iz. a 
s^wawi* 9 i k * < wr * £ k 

[0 10 5] (9) JJEl«kJJett*fte>raifclG 

»0W)fir*i*»*»ar4E'fC*H?t*i k *■ 
W&t-r&lM ( 1 ) ( 3 ) <7)MilAH;fE«i0^h' 

c o i o 6 ] ( 9 ) wKa^jstwtsiiifcojB 
mi. ±m*i<n>mm<mmmm-h. bp*>. juhe 

a®**.***) 2 &7tmmmm*Pimc?> 3 ^tc^m^ 

[0107]^(9) tlBttcoflWct «fc*Uf . IE^> 
*iSSI1-|> £ k fc i 0 . ttffl*±. *ld«tT=flr<rai 
[0108] (10) ttT-ya^afflk. i: 

y*t** k , ±ie a /xulu ste-t- 1>- ^ 9 

ffl^Rk. JJ23^ffiB6§»Hi#afcJ: | 5tfSIS*t 

*ifc±tB asft k jjaaw- zy- ^ 9 ynrnwrnnw 
zvmms/xittft. mf/xmmnwgizfci 

X. ^b>-^ 3 yffi$ltoRttX<ifflB£, ftS»S*tf> 
[ 0 1 0 9 ] ( 1 0 ) fc£*6^j£CIJW-&5Site> 

±ie^i&^2^nst«o^®T'(4, iimwm 

*lfc2&7C, X(i3&^^r>(£kLTfi^£*i.4<K 

(is i*M3#m§i-4#. B»nifc«L-cas«»a^ 



wte&yy- (by^y^ri^-h2, 4. tytr-ty 
7* U 7 . b y-f ffifgf BliSB 5 . b yimm 6 ) #121 
-f4*\ i^tyt^ffl^^^, HHSWiU^k 

3ttr k\ HRfc i < fifc 3 ^ffitfcfcfHflSfa fc 

#&. mmmtti^m. ■r^y-^^ymmi'm 
9t+ \*y- v 3 yft mu®& 8 ^i-ri) . ±i i$m 

^rw^7Wvbfarw^ k*<o««(Sfii 

^IBt^tr. r ^by-^ 3 ytffg£7)E14j 

[ o 1 1 o ] M o ) izmmmmzxtitf. as 
m k t*y- >- a ynwMt 3 ascflffls^tra^a 

«fc mmztifzBWMim/ximi-t'y-i'B ynm 
wmtWi+t°y-^3ymMnmmmmts/x 

&#<&m. RV/ximmm&tfMZftmt s £ k 

[0111] (11) ±E-^b*y-xa yflH8«s ± 

±mmtoMf/x\mi-t'y-i'3ymi®mBm 
Hmwmrn/x\m-r^y-^Bynm&im 

9-yX-hhZkZWBLt-thlMi (10) fclE»tf>-*- 

b'y-v 3 yga. 

mm&mix'* s tr^r-^-cawufHRW* 3 
mSi^Tivmi. w,\RVWi2<7mtemmx'\i. n 



I 



» 
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&7E b ? -b;Ur - ? iWRtt £ JEM t . ±1 B& 
- y(i . M 1 ^HJ6^®T'(i^EP 2 1 #!£i-f !> . 

^$»^-v\±. m 1 nm&<rmmx\m&x±z 6 0 
e?-b;K7)ft2 9 a^itaa*. mm^mz^z t £ 

[oii3] (12) ±imi- 1>- y 3 yttmst? 

#gft#gJ:9f#^i&^b>'-v3ytPB£. ±iEtil 

[01143^^(12) ^iaa^m^p-rsn^ 

1 3 #f£s-f c rtt 4 xrw ^ 

[ 0 1 1 5 3 z<r> ( 1 2 ) iziWLvmmzitai. ±ie 
do) tiB^o^t-y-vg ynmitfmmwm 

(10) tcie«^tf$gaai#SJ: m^ix&i-t'y-^ 

mti-ty-isB ymm-n§ffi±.m®t ixm 

[0116] (13) ±3imwmb±MSMrvr-is 
3yttmnmmmm.x//xiii]ftizmtx. + 

t'7-is3yfim<7)&Z%Htmt&Ztt:mittt±. 

IB ( 1 0 ) TiM. (12) effltifrizzmni-Ky-iss 
ymm. 

[oii7]io(i3) iz9ffl<7)ffimzmt&$m<o 
mmu s ±MSMi 1 Rx/m 2 nm&ommtimm-th . hp 



1 8> 9#123-f6#\ 361<*>3SfflW) 

mBX'(n$&2 1 t>#tf. &2<T)gm<nW&X' 

as* 3 cojEM&m 2 7 mm 1 . 

[ 0 1 1 8 ] ( 1 3 ) fclBttWBlJjtfcJ:Wf, ±lfi 
b'y-y 3 yfflfB^J&^kt* £ i:£J: 0 , ftffl£ 

^wests tfc. wmzumzmt 

. ffl^fctfffl jWiT n «. - & if *• SStWC 

tmmmmmLx&zmtZithibx. mm 

[0119] (14) JJEBWBfkJJES^t'y-^ 

sytt^mnmrnrnMRvvxittfaizmtx, -r 

fl»±fB ( 1 0 ) ftM ( 1 2 ) ofl*L*»t£awth*y 

[ 0 1 2 0 3 .1*0 ( 1 4 ) fclBtt^fllJSfcW-f 4Hlt<0 
JgJBtt. 13BS& 1 & V»2 <^>iat«0JB!B*«»ffit4 . BP 
*>. ±IB^b>'-^3yt*ISO||c7)*$ii:. «l<^dfe 

-a® 1 8 ^Mi-ri. # . si i comzcoj&mxo&Qi 2 

4 F^^M 3 2 7 iffig -fh . 

[012l3dO(14) ^IB®c7)^^ctii(f, ±IB 

3»5cffiaa?»H«i¥afc: J: OH-aiSiDt±iEB«*fc 
±iB»t t*y- ^ 3 y wattoffliWWrffiK tjE tT^ 

t>'-y 3 yflH8o*^*§^Efl:-r4 i t (c J; 0 . ft 

f5 ix -f t*y- y 3 yflfflkotiaas & i 
[01223 (i5) ±Mmwmt±.imi-^ / f- : y 

t?&±M ( 1 0 ) Jbm ( 1 2 ) <DM*ubHciEa<o*t* 

[oi233-^(i5) niBK^^tra-r^nsico 

JgJBIi. ±IE« 1 tfJUii^JB^WI&f h . EP*>, ±IB 
^««tf;Hli , S l comm^BMXlt 1 ? 'A \y 

1/-^® i 8^i^-ri.*\ iy%y(7)3Wi?y 



I 
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[ 0 1 24 3 ZW ( 1 5 ) fciS80>*j£fcJ:ftar» ±12 

Bmttcr>iT)H& t mmmmmm ^omhhzb^z 

4fc, »eS*ifcrat«>rt*i:5MIIi:V^»Sr4««Wc 

[0125] (i6) ±tmwmb±=m.i-^y-i^ 

mmnwmmtmtizb&mbti±.ii ( i 
0)^(12) oHitMcie»^t*y->' 3 vm 

[oi26]ic7)(i6) \,zmmm$uzm-fhm.M<v 

8 #s i t £ a* , * u 3> * ifco 3 ftjc 3 y e * - s 7 

I 0 1 2 7 ] ( 1 6 ) fc£tt*)*j£fcj:*llf , If 

ttf?%&. znzbizxL m%a. mmmmm 

[0 128] (17) ±IBS^fti:±ie»^t>'-^ 

a ynmncott n w&iai bumizmtx. bwmi&v 
/xtem-vr-is 3 vmmn*:T)v%b , ggM 

w>w-ybmmt&zb*mLb-?&±Mi ( i 

0 ) TIM ( 1 2 ) <0M*u&»ta*8^h*y-^3 VS§ 

So 

[0 1 29] ( 1 7) tea»<D«JSfc»**ISiiO 

tr;nw±. as i omMnmmxn? 4 u-^m i 

8 tff^-f & i)K XOzfyZbWttjtzyt*-??' 

2 ltfKl-ffctf. H«^A^2^7cMM^H^ 

[ 0 1 3 0 ] Z<F> ( 1 7 ) fcieftoffiricfciiltf . sk 
±SflHISl*#aoS^««t«1- 4filBIH«*± 



tmwzti%^m£mttM^?-y^mwx.izb 
[0131] (is) ±MBwmb±£.m-rt'y-is 

ijfoiTfit tew - $ ^SSft s *4 ; k * 

^kt£±fe ( 1 0 ) JbM ( 1 2 ) <0ffl*iM:iE»«0 

[0132] r^(i8) izimvffimzm-f&mm?) 
3V5im$¥m*mi&T-f&mtmzmmx'% 1 1 

-y<o*# §T'±fES&k±ie^b'y-^ 3 ytm 

^<n>mmwM*m.thzbiz£*) ^ mm%n. n 

[0 134] 

mjfith-rvr-i/nyiiffik. swrnbrni-vy-is 

lei 0. l«!ftk»^t*y-^a>««*i: 

[Hi] *fMHtf5» i <n%wwmz%h -r ty-i/ 3 

[02 3 E«tV'y7'*ittWrSfe«><0HT'*6. 

[03] E(Sv.yrsui^ws3t«><7)Hf*6. 

[04 ] &&tt<7)T-? kt*Bt*e#wH«S:*tH-C 

[05 ] wm<r>T- ? b wm u^mmvhim 
m&m*wpRtzt:#><mx'hh. 

[06] ft%lMlzmr)ttiit>titz-ty>'y7T]/-hX 

mmm t zmwt s ^<mxh * . 

[07] »«n«osia5t:ffiowt6ii>t-fcyyy^ru 

[ 0 8 ] W^SPfi^x - * 0$ B B B * - ^±T'^{2St- 

[09 ] ( a ) nm. ( D ) fimm?&iire-?<D*t^ 

09^^T0-C^fc. (A) ttrtSfito^**^^)* 



t'-f-isayimt LT^3&%*'U .x-At-??)!*! 

mm&bzs&Liz&F* ( c ) imw&^wmm 

[01 0] 09O (C) <v£o%m*£'i7otiit><?>W}ft 

[Hi i ] *wmw.2nmm<n>im\ l z&hi-\L j f-is 
[012] w,2cr)mmmmizii\ j thm^mt. znx 

i mm 

3 iTO! 

6 ±v+m\wm 

[01] 
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10, 10a, 10b, 10c 7-ft-7l/-A3<5; 

11, 11a, lib, 11c 3&7C#>J i-Af- 

12 SESTET 

13 ^ H H H^-^ 

14, 15, 16, 17 Sgi£j&fi?'J 
18, 20 VA\~7\s- A<g 
19 

2 1 ^EP 

2 2 rtS^B!*!^^^ 

2 3 n^u&<F>Rn&n*T)VT-?w&m:<r)im 

ft 

2 4 

2 5 fi1E£t^ffi<^aj$ffift^£lI€ 

2 6 Z«ffi& 

2 7 |*!3i£!<7)]EI^§i 
2 8 X^mSi 

2 9 1tfeT'±£ 6 Ob'? 

30 m^tmm^-m 

3 1 ^^ggSISr^-f-^ 

[02] 



ypHdi:YE«oa<MMJ*tt 



taiis(W4ipHoh) 
)-alss(y/ypitcfi) 

• • ■ 

d8t[Q][OIIO]-210 

<flSfl1][OH0J=2O0 

• • • 

<£5t{256j[2S6][25%-20 

• • • 
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[03] 



[04] 



* 





■ xo 


xn ■ 




xOm xnm - 


p 

yOp 


. P 
ynp 


-^>Hm 


yOrn^ynm 
zOm zrtan 


L^Op 


znp J 




Li t J 



imo R11 Rl2i|Tli 
iMUBUBiini 




[06 3 
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[07] 




mHp=pHm-1 ._l4a»(BfxH 

[xcyozdW* pHs eHc[0.0 00 0.0]' 

j-abstfc^pftuh) 
k-abs(zcfcprtch) 
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IM9) 




[HI 0] 



[H13] 



[Points on Screen] >f_ctos cHe ©Hp pHmfPdms on Mode*] 




~S1 



S3 



[um.vmj'c^ctos cHe eHp pHm[xm,ym r zm] > 



[ucv^^LctoslOAO] 1 



I 



S5 



Unp^h==sqrt((uin-uc)*9. + {vm-vc)''2) 
Dtrectton=((urr>iic)/L^g^,(vnvvc)/Lengiti) 



-S6 
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CHI 1] 



1 2] 





l>*c ybo zt«^ ':rtmaaa<D* * ?&ss?ottBs;i 

jfirMlomrtffitt^ra 5 St a - 9 M< 

mHp=pHm : '"l 4roffif?^ 

eHc=cHe- 1 ...15<oaMf?ll 
[rtm ytm ztm] 1 .mHp pHa eHc(xte yte^tc]' 
[xbm ybm zbm]' mHp pHe sHcfx&c ybczbe] 1 
drection=[xtm-xbni ytm-yom ztm-zbm]' 



«S«IBS#K»^§2TB43 



2^ *y 



2-Sf- *U 



(72) mil /Jn« m± 

(72) ftffl* g» ft* 

mSSRfceK«y£2TB43#2# *U 

F^-A(##) 5E501 AA24 AA25 AC15 BA03 CA03 

CB14 FA14 FA27 



